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DESCRIPTION 



GAIT PAT TERN GENERATING DEVICE OF WALKING ROBOT 

5 Field of the Invention 

The present invention relates to a behavior 
generating device of a bipedal walking robot, a humanoid 
robot or the like, and particularly relates to a gait 
pattern generating device of a walking robot for generating 
10 a walking motion in real time, for example, using a 
previewed or planned future zero-moment point (also 
referred to as "ZMP" in this description) which will be 
obtained in a few seconds from now. 



15 Background Art 

In order to explain the background art in a way easy 
to understand, description will be made first about a 
"table-cart model" in which the characteristic of a robot 
is simplified. 

20 F ig- 9 shows an example of a bipedal walking robot 

aimed at by the present invention. The robot is not 
limited to such a humanoid robot, but the robot may be 
formed into various shapes such as a bird-like shape, a 
dinosaur-like shape, etc. if it has two legs. 

25 ^e technical problem of such a robot lies in the 
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fact that the center-of-gravity position of the robot 
exists in a high position in spite of a small area of its 
sole so that the robot may fall down very easily 
particularly when the robot supports its body on one leg. 
5 The dynamics of such a bipedal walking robot is 

expressed by a complicated equation of motion, but its 
rough behavior can be approximated by a table-cart model as 
shown in Fig. 10, This is a model in which a cart having 
mass M runs horizontally on a table whose mass is 

10 negligible. In this model, the pedestal of the table is so 
narrow in comparison with the running range of the cart 
that the cart as a whole will fall down when the cart 
reaches an end of the table. 

That is, in this model, the horizontal displacement 

15 of the center of gravity of the bipedal walking robot is 
replaced by the cart, and foot portions of support legs are 
replaced by support portions of the table, Z h designates 
the height of the center of gravity from the floor surface, 
and x designates the horizontal displacement of the center 

20 of gravity. Since the center-of-gravity position of the 
robot substantially coincides with the waist thereof, the 
motion of the cart can be regarded as consistent with the 
motion of the waist. 

Incidentally, the robot walks three-dimensionally. 

25 It is therefore necessary to imagine table-cart models 
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respectively for a motion in the traveling direction and a 
motion in the left/right direction. However, these models 
may be dealt with independently of each other. Therefore, 
the following description will be made about one model* 
5 Now/ when the cart is running toward an edge of the 

table at an appropriate accelerated rate, the cart can be 
prevented from falling down. In this event, in one point 
in the plane where the pedestal abuts against the floor 
surface, there exists a point where the moment acting from 
10 the floor surface becomes zero, that is, a zero^moment 
point (ZMP) . 

The following Expression 1 is established based on 
the definition of the ZMP when p designates the position of 
the ZMP and t 2M p designates the moment around the ZMP, 
15 t 2MP =Mg(x-p) - Mx"z h « 0 (1) 

It is understood that the position of the ZMP can be 
obtained by the following Expression 2 when Expression 1 is 
transformed. 

20 p = x x " (2) 

g 

From this expression, a motion p(t) of the ZMP can be 
calculated easily on a given motion pattern x(t) of the 
cart. 

25 To generate a walking pattern is to obtain a motion 

of the center of gravity attaining a desired ZMP trajectory 
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depending on the landing position of each leg or the like, 
from the desired ZMP trajectory. In the background art, 
the following two methods have been known as methods for 
calculating the motion. 
S (1) A method in which a desired ZMP pattern is 
transformed by Fourier series so as to solve Expression 2 
in the frequency domain, and an obtained result is 
transformed by inverse Fourier series so as to calculate a 
motion pattern of the center of gravity (for example, see 
10 Takanishi; Biped Walking Robot Compensating Moment by 
Trunk Motion, Journal of the Robotics Society of Japan, 
Vol. 11, No. 3, pp. 348-353 (1993)) (hereinafter referred 
to as "Background-Art Technique 1"). 

(2) A method in which a three-term equation obtained by 
15 discretization of Expression 2 is solved so that a motion 
of the center of gravity attaining a desired ZMP can be 
calculated easily and at a high speed (for example, 
Nishiwaki, Kitagawa, Sugihara, Kagami, et al.: Fast 
Generation of a Dynamically stable Trajectory of Humanoid 
20 with Linear Decoupling and Discretization of ZMP 
Derivation - attained in Perception-Action Integrated 
Whole-Body Humanoid H6, The 18th Annual Conference of the 
Robotics Society of Japan, pp. 721-72 (2000)) (hereinafter 
referred to as "Background- Art Technique 2") . 
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(3) A method in which typical walking motions are 
calculated in advance, and the motions are combined to 
generate stable walking in real time (for example, see the 
Unexamined Japanese Patent Application Publication No, Hei 
5 10-86081) (hereinafter referred to as "Background-Art 
Technique 3") . 

However, according to the aforementioned method of 
Background-Art Technique 1, it takes much time for 
calculation due to considerably complicated processing, 

10 Thus, the method is not suitable for generation of 
locomotion in real time. 

The aforementioned method of Background-Art 
Technique 2 is high-speed enough to generate locomotion in 
real time. However, it is necessary to calculate a 

15 trajectory for every several steps by batch processing. 
It is therefore necessary to pay attention to connection 
of the divided and calculated trajectories so as to 
prevent discontinuity among the trajectories. In addition, 
there is a problem that "unevenness" occurs till a change 

20 in the desired ZMP value is reflected. 

Further, according to the aforementioned method of 
Background-Art Technique 3, it is necessary to prepare 
typical locomotion in advance. In addition, there is a 
problem that locomotion which can be generated is 

25 considerably limited. 
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It is an object of the present invention to provide a 
gait pattern generating device of a walking robot for 
generating locomotion in a simple manner, in which the 
foregoing problems are solved by generating a walking 
5 motion in real time, for example, using a previewed or 
planned future 2MP which will be obtained in a few seconds 
from now. 

Disclosure of the Invention 

10 In order to attain the foregoing object, a gait 

pattern generating device of a walking robot for generating 
a walking motion from a desired ZMP trajectory using ZMP 
preview information according to the present invention is 
characterized in that a driving quantity of the center of 

15 gravity in one moment is determined on the basis of a fed- 
back motion state of the center of gravity in that moment, 
and a previewed or planned future ZMP trajectory, so as to 
generate a walking motion in real time. 

In addition, the gait pattern generating device of a 

20 walking robot using ZMP preview information according to 
the present invention is characterized in that the walking 
robot is a bipedal walking robot. 

Further, the gait pattern generating device of a 
walking robot using ZMP preview information according to 

25 the present invention is characterized in that the 



6 



0 5- 3-24 ; 3M9PM;NGB MM 



MORGAN, LEWIS 



;0355613955 



# 20/ 55 



previewed or planned future ZMP trajectory is corrected 
based on a detailed dynamical model of the robot in 
addition to a basic model using a table-cart model. 

5 Brief Description of the Drawings 

Fig. 1 is a block diagram showing generation of a 
trajectory based on preview control according to an 
embodiment of the present invention. 

Fig. 2 is a graph showing a motion of the center of 
10 gravity calculated in a method according to the embodiment 
of the present invention, and a ZMP obtained as a result 
thereof. 

Fig, 3 is a graph showing a preview control gain used 
in the embodiment of the present invention. 
15 Fig. 4 is a graph showing a motion of the center of 

gravity calculated when the preview time is short, and a 
ZMP obtained as a result thereof. 

Fig. 5 is a view showing a simulation in which a 
bipedal walking robot is walking. 
20 Fig. 6 is a graph showing a difference between a ZMP 

(broken line) based on a table-cart model and a ZMP (thin 
solid line) based on a detailed model in which motions of 
limbs are also taken into consideration. 

Fig. 7 is a diagram showing the configuration of a 
25 ZMP correction device based on preview control according to 
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the embodiment of the present invention. 

Fig. 8 is a graph showing a corrected ZMP trajectory 
based on the detailed model. 

Fig. 9 is a view showing an example of a bipedal 
5 walking robot aimed at by the present invention. 

Fig. 10 is a view showing a table-cart model for 
approximating the dynamics of a bipedal walking robot. 

Best Mode for Carrying Out the Invention 



[Pattern Generation Based on Preview Control Rules] 

First, Expression 2 is expressed as the following 
dynamic system with time-derivative of acceleration (jerk) 
15 of the waist as an input and a ZMP as an output. 



When this system is discretized with sampling time T, 
the following Expression 4 can be obtained. 
x k+ i = Ax k + BU)< 
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The present invention will be described in more 
detail with reference to the accompanying drawings. 



20 




(3) 



25 



Pk = Cx k 



(4) 



where: 



x k s (x(k*T) x' (k*T) x"(k*T>) T 



u k s U (k*T) 
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P* = p(k*T) 



5 
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Assume that: 
p k " f 

designates a desired ZMP trajectory of the output p k of 
15 Expression 4, and a performance function is provided by: 



where Q and R designates appropriate positive numbers, 
20 Consider a problem of how to minimize the performance 

function so as to allow the output p k to track the desired 

2MP trajectory as correctly as possible. 

According to the preview control theory proposed for 

the first time in "Hayase and Ichikawa: Optimal 
25 Servosystem Utilizing Future Value of Desired Function, 

Transactions of the Society of Instrument and Control 

Engineers, Vol.5, No.l, pp. 86-94, (1969)", a control input 

for minimizing the performance function of Expression 5 is 

provided by the following Expression 6. 



J - E {Q(p 3 rif -p 3 ) 2 +Ru, 2 > 



(5) 



30 
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U k = -Kx k + [fi,f 2 ,-..f N ] 



ref 

rPk+i i 



(6) 



This expression shows that the driving quantity of 
the center of gravity in a moment is determined on the 
basis of the fed-back motion state of the center of gravity 
in that moment (the first term of the right side) and 
desired values up to the N-step future: 



10 



This corresponds just to such a situation that a 
driver of a vehicle can drive the vehicle smoothly by 
turning a steering wheel while seeing a curve of a road 
ahead. 

In this case, N corresponds to how far the driver 
15 sees the condition of the road. In addition, t=N*T is 
called "preview time", meaning the number of seconds in the 
future to take into account for control. 

The characteristic of the preview control can be 
adjusted by the parameters Q and R in Expression 5. When 
20 the Q is made larger than the R, a motion of the waist with 
which the ZMP will coincide with the desired value as 
correctly as possible can be obtained. However, the motion 
of the waist will be a violent motion with a large 
differential value of acceleration. On the contrary, when 
25 the R is made larger than the Q, the motion of the waist 
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will be smooth. However, the error of the ZMP from the 
desired trajectory will increase. 

Incidentally, a feedback gain required for the 
preview control is calculated as follows, 
5 K s (R+B T PB) -1 B T PA 

fi= (R+B'PBJ-VtA-BK)™ 1 - 1 *^ (7) 
where P designates a solution of the following Riccati T s 
equation: 

P = A T PA + C T QC - A T PB(R+B T PB)" l B T PA (8) 

10 When the method shown here is used, there is a 

problem that some offset error remains in the ZMP. This 
can be solved by introduction of correction described in 
"Egami and Tsuchiya: Optimal Preview Control and 
Generalized Preview Control, Instrument and Control, Vol. 

15 39, No. 5, pp. 337-342 (2000)", 

Fig. 1 shows a block diagram of trajectory generation 
based on preview control. Tacking on a desired value of 
the ZMP output is achieved by a preview control system. In 
that event, the state xjc+i of Expression 4 calculated 

20 concurrently is a motion pattern of the center of gravity 
to be obtained. 

Fig. 2 shows a motion of the center of gravity 
calculated in a method according to the embodiment of the 
present invention, and a ZMP obtained as a result thereof. 

25 The upper graph of Fig. 2 shows a motion pattern in the 
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traveling direction, and the lower graph of Fig. 2 shows a 
motion pattern in the left/right direction. it is 
understood that a proper motion of the center of gravity is 
generated in accordance with a step-like or rectangular 
5 desired ZMP in each pattern. 

Fig. 3 shows a preview control gain used. 
As is understood from Fig. 3, the gain at 1.6 s is so 
small that there will not appear a large change in control 
performance even if any desired value in the future from 

10 this time is used. Therefore, t=1.6 (s) is used as preview 
time in Fig. 2. On the other hand, when the future preview 
interval is short, the control performance deteriorates* 
Fig. .4 shows a result when the preview time is set at i=0.8 
(s). It is understood that the stability is secured while 

15 the ZMP tracking performance deteriorates on a large scale. 

In such a manner, according to this system, the ZMP 
up to a certain point of the future has to be decided. For 
example, in the case of a robot walking at an average of 2 
km per hour, the preview time of 1.6 seconds corresponds to 

20 looking 0.89 m ahead. Meanwhile, it can be considered 
reasonable from our intuition that we cannot keep walking 
in peace without looking ahead to such an extent. 
[Use for Correction of ZMP Error] 

Desired walking can be attained by driving to allow 

25 the displacement of the center of gravity or the waist of 
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the robot to coincide with the trajectory calculated in the 
aforementioned manner. Fig. 5 shows a simulation in which 
a bipedal walking robot weighing 62.5 kg is walking based 
on a calculated center-of-gravity trajectory. 
5 Here, the problem lies in the fact that there occurs 

an error in the ZMP because any accelerated/decelerated 
motion of any limb is left out of consideration in the 
table-cart model in Fig. 10. Fig. 6 shows a difference 
between a ZMP (broken line) based on the table-cart model 

10 and a ZMP (thin solid line) based on a detailed model in 
which motions of limbs are also taken into consideration. 

There is a possibility that walking becomes unstable 
when the error of the ZMP increases. Quite the same method 
based on preview control can be used for correcting the 

15 error of the ZMP. 

That is, it will go well if an expected ZMP error is 
calculated prior to walking of the robot, and a corrected 
value of the trajectory of the center of gravity is 
calculated based on the expected error. Fig, 7 shows the 

20 configuration of a ZMP correction device based on preview 
control according to the present invention. 

Fig. 8 shows a ZMP trajectory corrected thus on the 
basis of a detailed model. As is apparent from the drawing, 
it is understood that when preview control is used, a 

25 stable walking motion attaining a desired ZMP can be 
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generated even in a robot having a complicated structure. 

Incidentally, when preview control is used for 
correcting a ZMP error in such a manner, the corrected 
value is not so large. Therefore, it will go well if the 
5 preview time is short. In the example of Fig. 8, the 
preview time is set at t=0,75 (s) . 

In comparison with the background art, the present 
invention has excellent effects as follows . 

(1) As compared with Background-Art Technique 1, the 
10 speed is very high in the present invention because easy 

product-sum calculation based on Expression 6 is performed 
simply, while Background-Art Technique 1 needs Fourier 
transform and inverse Fourier transform. 

(2) As compared with Background- Art Technique 2, the 
15 trajectory of the center of gravity can be obtained 

continuously every moment in the present invention so as to 
save the labor of calculating the trajectory every several 
steps and connecting the calculated trajectories as in 
Background-Art Technique 2. As a result, the program is 
20 simplified extremely. 

(3) As compared with Background-Art Technique 3, typical 
locomotion does not have to be beforehand planned at all in 
the present invention. Thus, a proper trajectory of the 
center of gravity can be generated desirably only if a 

25 desired ZMP pattern is provided. 
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Industrial Applicability 

Since the present invention is configured as 
described above , the present invention is suitable to a 
5 behavior generating device of a bipedal walking robot, a 
humanoid robot or the like for generating a walking motion 
in real time. 
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[FIG. 1] 

Al: DESIRED VALUE OF ZMP 
(UP TO N-STEP FUTURE) 
A2: PREVIEW CONTROLLER 

EXPRESSION (6) 
A3: ZMP DYNAMICS 

EXPRESSION (4) 
A4:_ CENTER-OF-GRAVITY TRAJECTORY 

[FIG. 7] 

Al: CALCULATION UP TO N-STEP FUTURE 

A2: TRAJECTORY GENERATION BASED ON TABLE-CART MODEL 
A3: DETAILED DYNAMICAL MODEL OF ROBOT 
A4; ZMP BASED ON DETAILED MODEL 
A5: PREVIEW CONTROLLER 

EXPRESSION (6) 
A6: ZMP DYNAMICS 

EXPRESSION (4) 
A7: CORRECTED CENTER-OF-GRAVITY TRAJECTORY 



